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(74)ft9?A 





(54) [3&BJ§0^] ^h>3fcif^*^^-*ra>3J!W6-fe>-9-- 



(57) [Btt] <»iE«) 

^CDS6^ £ IBtlc-» ^ n 3 i± £ . 
[tftfiS) 0 1 0 4.l*3i««l 4 2, 

14 4'*WU S^O^*h>iafitSCDJlffiC0X, Y&^ 

3tiA:2*r(D*ffi*s*5. &*(D^h>i*(it&£JiU<D 
it1i*t<D 1 0i©lffl«:*S«»14«^a3&«X«lStCittY 

l©Sffi»«t»«»2(D*ffi»*ifl5ja:3nTC^.' 
A&i^ga^Ofi-^fcSff U h ><DX, YR 

ClfZBHll*l|-Wr*ft:»K:cti6*«-#*«ffl-rsCP 




• "1 . '■■ 

thuib® 2 (omw&im&w-mft^ktt&mmomv 

IB® 1 i»2©WS«*s|WB¥«aX»»»J:CcJBj«3 
[ffl*Jf3] RFg2stS*®«. --©MSIBIHJPBr— « 

[000 1] 
[0 0 0 2 ] 

[0 00 3 ] *£*TW:*B4*Stflr 4,705,9 



(2) #P8¥6- 1 6 1449 

4 , 087 , 62 5^ CCth 3 tl X I gltt^Jc £ ^ U ? 

x , yis £Haecaias±©>< f>sc * a 5 ^<o 

#«YB«*»5&rite»Jc«ir»6ti*«#itt^<* 

X. Y18<0||IK»»LtC>*.' . . 
[0004] jtlTK«S©«l*atfffiiBHz>*-(C*Jti"C 

<iK»£Lfcft#(0«^©H«C^^A^y*J*i.- Gil 

■ A«»i>. 

[0 00 5 ]':*#W!tt, X. YBWDf 5 - 

20 i/. &tc#mmz^b>f)mw%w< tzzmz-rz^ 

[0 0 0 6] **IB<0fl!l(0SWW, 2-oStC»tt^n«± 
Kffl. En^r^A^^WMWCCti2*:<DF7AX7 : * 
[0007] 

*j*orti4isafi-^'t?fftt-r^ J FF'7Ar**. S 

-T-63ill«*WOri^. ST-F^AttX, YRtfZffi 

[0008 ] .a«<D/^ bi>>mm®L<DiiLm;*&:m-?z>tcisb 

tc. F^A»^*ift^6n/cfflil«c^ffltt^J#BS^£* 

40 .oti^. m\<ommnt, s^<D^F>sfem«£»i 
©affi*t«, s«<D^h>asfi«£»2a>aflB*(opa<o 

*Mtt©fe^3WY(»fcH0T/<F>^«<DttK«:"» 

s^oKffi^xsofYiaaijEKtcafjsr sec, 

fft©«flBtt*S/-jUF0ai*J:5CcJBJSESn. 
50 §^n>(DX, YRi^Zffi«*it»r*/ca«>tc,' c 



(3) 

3 

mm?** cputt*^©^F>a««3a*F9 

'ft: h U'3tf-«#.*^-r*l9* : F«r*. 
[0010] **M©ffi©BWaiW*«"tt. HM£#M 

[0 0 11] . 10 

[|B»W] HI CO*. ^h>l 024 104. acfffiSE 
-fe>1f-l 1 '■0%WT*tt#ittao«BEO^^>A 1 0 

o^^ntc^o -fe>-y--i roil -e<^±®ic^u 
ts^©A'»(D (x, y. z) {aa*tftuu 

1 1 4tc*ff&b/cfi[afi^«:%i-r4 0 jgtc. ^'h># 
F^AXf *^4 l,Tffll*6*lTl*£t!^" -fe>-!f- 
tt>* h KPIJffl Lr t > & £ ^ ^ > ^M-^^r ^ -f > 

[0012] »*oc^iswcc*jc*r, ■fltaftia^'f- 
n. ^Lr»-feif-rif-— cd^^> l i4&ci*fi3ft 

rffll^ti*»^«c % ^K>1 0 2<DX{4a^^>*fe1f 

U 1 0 2cDY{4a^K^ACD^fe^$0SPT€>ft: 

8&CCffli,»6*i£C4rtVC#, ^b>#^ffil 12£PP< 30 
tStD^hXDiSKttK^At-KD^'jA-A (MS 

5>^e^ttK^Afc5- F 

[ooi3] **eB€>(fe©i£««:*jci'r«. ^vxf 
ai ootc^orffl^^n^fi-^^^fiT^ai 20 

[0014] faWMZsV- 1 1 0»^*5i?'>^l 22?: 
^LXtoK). C©^^l>>y»-€-<3[>±«ffil 12©2< 
CC-fe>^>^^^U-v h («&D«) 1 24 4fI-3f«OT0 40 
SSI 3 0*^L"Cl»S. HI (a) ^Rg-Ttitt. -fe> 
-»^^l/7H24 tti8l»tetl» 1 3 6 < , 
0.2 craO!>/13*Wr-S-r>^-^Il) {tJ^TIMHSft 
Tl*-S2o<?>*«H 1 3 2 4 1 3 4±tcM5ti/c4o 

rtt, T>r^ (H2&o*H3ct^3nrt>£) ti^'y 

50 



t#8?¥6- 16 1449 

: 4 , 

[0015] h:>©«Ctt* ^ftjRMKn^ 
1 4 2 £ 1 4 4#s&£. h >i£ilt8 1 4 2 4-fe>lK- 
1 1 0<D4^<D&zOT>ri~ffl<D<&m&1fe&m&^ b 

tiSiWIJHiBa^«#©ifc3 WCTTS C 4tc £oT?#e> 
tiS. JE*C WBKW:,. ^ >a«« 14 2 414 41*. 

[0016] H2&efH3(ct2/ 2*t<DT^7*i- 15 0 
- 1 5 2&tfl 5 4- 1 5 6*«7S3nri»*. Tl*?T 
15 0 415 2 fctjg 13 2 (HI #JH) ±«CJBfiSStl. 
*?cT>f ^1 5 4 4 1 5 6ttJil 3 4_Bcff*JiK3*vC 

jitkmmmRommi 5 oa- 1 5 0EtM$nt 

T->7** 15 0 4 15 2 te^* h >©Xffia*MS 
«<D^:# 3*5X1* (H2<Z>^v^^(OX*l«-Cm3tiT 

S3^Y«.(H3©y v^*©Ytta.r*3nTlr^) 
ecffio/ciaacciajlKitcttWTSJ:^^:, t>t^ 1 5 
4 4 1 5 6 6i^^tt«Ctt^Tl^B!tt<DMa«fWl/'C 

[0017] ^h>4r>^4(Dffl<OSat3aS^*cJ: 
or, Cfl640<DT>T-^ 1 5 0- 1 5 6<D#*-(Cfc 
o"CSff3h/cM«^^ffW^-f>l 6 0/16 
2., 1 6 4S«Jf 1.6 6«Cj:->"C4-^©RF.»iH8 <H4 

[0 0 l 8 ] B2«i7S3ft*J:5Cc, Sr>^<D8IK 
<Z>«a«»t*»«S^>f > 1 5 8Ct<fc~>Tffl5:B*fcS*l 

CC0T>^^^NV^->cr>M^Jl H13 2_L<D2o 
<DT>n- 1 5 0 4,1 5 2*511 3 4±©7>ft 1 5 
4 4 1.5 6ecfia^ttl>C4r*0 (ggS7^f>15 8 

*HK) . ffl-?t, tvt^i 5041 5 2cdai*«f4' 

«T>-r^ 1 5 44 1 5 6*><h>;fr>6S'--fl'K0fc^ 
C4-C^>^> 0 

[00 19] 4O0^n©r>ftl5O. 4 15 
2\ 1 5 4 SUM" 5 6tC<fcor-M h> 1 0 2*>65fi0 
ft:fi-^©*fiCCffi3r&4o<DSBE-te^ FVX 1 , VX 
2, VX3MVX4^^i, (XK YK Z 
1) 40TCCfC7n3tirt»-6*l<D^h> 1 0 2<Dffi 

[0020] VT=VX1+VX2+VY1+VY2 
X1=K1XVX1/-(VX1+VX2) 
■Y1=K2XVY1/(VY1+VY2) 
Z1=K3/VT 

[0 0 2 1] CCC 4 K 1 4 K2Ri^K3W^<h><D(a: 



(4) 

5 

h>l 0 4CD (X2, Y2. Z2> fitiB*j*«>*/c8?> 

t> ft zmmtm 2 <dj* f > 1 0 4 te <t o r iuft £ ntcm 

[0 02 2 ] ZISlilO(D7>7"tJ}. Wfctfr:^ 
tl50il5 2^6<Dm-^<D^IttCiMJ:tt?«'r^J: ; >(C 

itffsna (w, z 1 =K3/(vx i + vx2) ) c 

[0 02 3 ] W %;#JHTtitf , Jd£<DJ; 5 OC, -te^ir 
-1 1 0ti4o<DT>7 u ^l 5 0, 1 52.1 5 4Rtf 10 

iS&fcJ^T. cti%4o©r->^©S^ tenors . 
■«3 nfcMawaaKm-^tt^ ^ > 1 6 o , i e 2 , 1 6 

4M'l 6 6"C4"o<DRF*MB31 6 8 6CSKn, RF 
*ieS16 8B7-r>17.'0, 17 2 4 17 4M17 

6 _Bt 4 -?©«mb ?n/cr>f * \m £ „ 

[0 024 ] §*7(£>^h>l 0 2,. 1 0 4 6CEi, 

7 0- 1 7 6Cc4o©T>^e-^(D?»3*ttlH-r*» 
JJiSit^ttJ^^^o tfefflgll 8 2tt^h>l 0 2CC<fc 20 
o r am 5 fttc R F H«»0 4 OCDT > f - t"- {f-5f <£>® ffi 

««C, 8 4tt/<F>l 0 4tCj:^tg(l$n/c 

R F H»a»©4 o©r'>f - tfif ©5SK«cffl^T S d c 
^lEfi^^r 7-/>l 9 4lCf&£T 
[002 5 ] F>*>£©T>^m^<MfcK* 
^tdc iSi^TtD ^- ^ V • 3E8M ( A 
DC) 2 0 2*SoT/WF$7*v 1?*JU • n>t^£i& 
1>«:CPU2 0 OtcHiM&Sti*. ADC2 0 2ttf£JB 
3n-&«fJ*ttADC 2 0 2CC«K|?U-C., **<DMEEfI-*i 30 

tor* a. £T©8*EE«#ttJaww («itf]»B 

cci ooo@) (cc PU2 o occj^-cr**!. ^or 

77 h^x72 04(93«CDTT\ CPUtt^U^l. 

0 2 t 1 0 4 (OX, YRtf Zffi«*ft»T£/ctf>(C, C 

^ • F**£-T£C £CC<fc-?TC*i6<DM I D I 40 

fflffll^ ^ J - 2 HUSST £ . 
[0 0 2 6 ] jlHlt^lWcfcUtti. SfU£>^F> 

1 02 ©kmc* sates© (x, y, z) (aa*^-r^ - 

7^-^X1, Y 1 RtfZ 1 *fl6fflU ^2 h>l 
0 4<D*afc**i£(IS<D (X, Y, Z)&i4/TfA7 
^-^X2/Y2R»Z2S(6ffl , r-5. Cn6 6o0;s 

7Jt-^^e>nsi. xiiYi^^-^tai 

Wtm^hft, X2iY2A7^'^«^2©MIDI 
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6 

■■hacij&st?**. ^fe^F^Atr-F#>6/£&Mi d 

I**ti. *KE-r * Z ffls&s-fe >tf — 1 l-0'©*ffii 1 2 

z = o ) cc'sja-r-sKKi, §m i d i ^+*;kc?& 

[002 7] H*5ttq u a d RFWiSl 6 8 K&flJ 

^n/c4oco»^^WaS© i oissort^a..' c 

<ORF«'«S2 1 :2<Op4 >2 1 0©A#fI#tt4O<D 
7>ft7^1 6 0- 1 ■■6 6©lo{C^3tiS 0 C 
<DRFWfg«>7-f >2 1 4±<Dffl#e^BttfflHi» 
<B4#J&) «CC»< 4ocD^>T> 1 7 0-1 7 6<D1 o 

tctt^sns.. cfD3is:Bua^*sS2 i-2«»*uV*' 

[002 8] 75,76KH2CDjg^a«:tB^*r^l3.2 

■0Tc?a«M.&«#tftffl8r8 2**briri.*. j^ss 

82 2 0tiMh>©loi 0 2iHacc4o©RFfi# 
-ttWg-2 2 2A-2 2 2.DtC«£3ftri>4..«£o-T. 
#£8182 2 OA>6CD|B]DRFf|^h>©lol.O 2 
KJ:oTi8m3*iiRF{i^£*£U 4oC[)RFff^ 
*&ttJ82 2 2A-2 2 2D<D-te? h£ F^ y Ztctb 

[0 02 9] ii^cO^*h>l 0 2-XW1 0 4UlttUX. 
*fj£-TS«lSS2 2 0 £ 4 OC9R F(l^fflS2 2 2 A 
-2 2 2D©.t?hM^ B &/tK>fck Ah>*6© 
ft #3&«8B^ tc«fflS-ti»S J: ^ Ccatt-SH««*«ffl-r 
B*Ut»lltSWi2o©/<h>4WLrt^Wti<i: 

h>^tt&RFS«»£»l£^5RFt!iUl»<0-i2^ h 

[003 0] S^r (0ftl«««ttfl^tftUBIS2 2 2 BA 

*«BEK7^^-2 2 4 % *titctt<S»*tMS2 2 6 
( LF347)Siy e «fglslB2 2"0«>ttffiH«» , r^ 

^>23 OCcWIA^lfi^ ; S:^>70U-r^^>7**; >^ 
iB2 2 8 mit LF13202)^WUrt>^)o Xtt 4 
>2 3 0it Wil«H 5 «C7S3*ifcR F*i«S©'— 
m*^-<> 1 7 0tCl$4*3*rtl»<5. ftfeC03ocDRFft 
^«iaielB2 2 2 B. 2 2 2C2SCX2 2 2 DWflfe©RF 
(H4#JH) <DWl\%^4l/\ 7 2, 1 74R 

[0 03 1 ] 1f>7'y>^(elffi2 2 8CDffl^W^-r>l 
9 2&tT>7"7"cr>— OCCi-oTSfiSn/cR F<f-^<D^ 
S^CtbW U jTc£S& d c Ui^ff -^*»*-r S i; ^ K R C 
a -;^7 ^^-23 2k:J:^T6iS3tx^o 

[00321 87^ ^h>l 0 2£{iS-fe>-^- 1 1 
0<DF^A«ffil 1 2*07j*UTl»£. a) 
^■«h>3&5Sffil 1 2^:P[)^/ciECi^cB$P^ffl^~r^^^ 



i v k ^ a tr - h ^nri^ci ZmTtctb cc^^ 

<f±r % - Z = H I TCD{ig^-rmi<DM2 5 0, m> 
^F>#F^A*ffil 12^a2«0ffl2 5 2it±*J 

lc»t»{iH«c*S»2<Dffi.2 5 2W^ e C<DSff2<Dfli 10 
.■<Z>Z^ri»l<Z>tfl[|BttZ='SETX*S. ffiU SETttF- 

^ ^as±o^ 2 (omom 5 r * 

,■[0 03 3 ] #8Hfc». Z*|pJTO^F y 
F7A tr~ F.*t>fcttft<^*ffifc Ci:^S^ F ^ 

Aian#©^©tt* KiiEFgcclBjJW $ *ir t, > & c £ ttfis 
bm i d i mm*m?m^*&*£?z>®fm£<Dmicmm 

[0 034]M8^-TJ;^tC, iz>U*-cDCP Uk£*B 

flUW^^n/cB$m^ATk:fc^rz{i^^iis*-r^. 

■/*F>1 02i 1 0 4OT^ h U*<Jl/ «fc ») _BC (Wt 
'K. Z>SET) _btf 6ft£«CC* "^FV-r^^V 

>^-fe>if-^® (z = o> ccfa^-oT^i&u t*> f 

u^na'T Z<H I T) CCtt£<fc % a?F>* 

7v^>-»y * US?;*£-tt2fi<D F «; 2/-*l,ttt» 30 
J:9CC0<Oft**(0^.r6n. -fe>^-©CPU200 

[0 0 3 5] ajff = ( Z last- Z current)/AT 
CCr, Z current «-fe>*^-<D31ffi<DZfiS"C^> f 3, 
Z1astii^>1f-<0^©*feWU<fflS3n/cfi[», 
ltATtt/< F >fflK<0«ffii*©«<!MIJS©«FWiniH 

[0 03 6 ] ^>y--<DCP\J[t^m$titcJ>^? F 

BSPJI) *ft»-r-5. ' 40 

TC=T current + (Z current /iESE) 
CCt, TCii^»^ FCD^iMBJM-CAO. Tcurren 
t »3EgaEflr>B$Br*^. -fe>-9--(DCPU5i, ^iMDSIffl 
TC«t^F><£>X. YSCfZai«Oli«:W*r-5 F 

- 1 2 0^i££ o 

[0 03 7 ] ^ F>*Hz* F U-^L^OJb. £P*>Z>S 
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8 ■ 

6-fe>tf-ffii i 2*r©^F>Q»tti»iatt-fe>if- 

<Dtt.»«ftT delay ^Sl^ ■ 
[0 03 8 1 09^ F >#ffi*P|J < BS*^fflLX& 

GPU2-0 pteJJH>6*i*V7 F-)x72 0 4©7a^ 

-5 F ';#-fi^£ F y #-«FWibi F >©XRWY0tt. 

v ^ tF -ftf — <D«fc 5 &^HS0Dt/> -f If- £8HJiBJ 

^■<DFy//-t?iSBtsn4'. 

[003 9] -fe>*tF-->X^A«ffllve>n/c^< F><D 

-t* * u t cne»©^o ^«i©c p ' 

'U2 0 OtcJtoTWf ^>3.tiS.Ci«:a.Br^#'C" 
-5. fSo-r. 1 o<zv* F><D^n^A*s^©WFlBlffllO. 

[0 04 0] (l^FVffltOJ^P^AIt >*F" 
> (*Ty ^X3 0 2 ) <Dtc&>(D7 IsT-fm^-C^tft; 

F>©zfajB*§t»brc*s*4ii$raiaiB a 

T) ^Ci(cJ:^pgtet^ fcU /*F>*Hz*F 
1(^7^X3 06) ±fC*-S«c*6, V7 F^xTW^ 
F^flJO^^Hz * FStl (^'7^X3 0 8) . ;^CD 
B*HiniB (^'^X3 02) (Dtc&<Dm*>%m&Zi;&<D 

r -)i7tt^h>*ifc ^ FffiCDTecAS^^rO^^rJaJS 

FBSMTc*^-r f >;^/-m-^*s««:afisn 

2)«r^*y^T*. feL. F U #-ffi-^#«CCiSm ^$ 
ntl^^, J* F>^t ^ FffiflOTfc^C^Stf, 
F^xTi^'D^A (#?^X302).(Dffl«)StR 

[0 04 1 ] fcO, ^■F>'*SBWcH2>*-ffi-(#y^'X 
3 12) J&PPC^ri^lr^. Fffl<0T*C*5tt6, 
•fe>-*-v:7 F^xTtt*SB*ParaiB (#^^^3 1 
4) ft-o 0 *:L,X-k>D-—vy h-)x7B^F>©7> 
r*7"fi-^^^, ^F><DSaE<OZ<4SB (ZT) , ^F 

><oiiK ^F>3^-fe>-9--fficci$i^or«Hi 
W^x3i6) ^itm*r^> 0 */c/u>oxsc;y 
Tc<h^'F>oJis<Dx, Yacfz-cixaiB^wrs f »; 



(6) 



[004 2. j- &"u ^-^^sWTijf'.oawttt's ^ : 
■©;^>«c»ut) x, Y&Kz*w-si/. -en-eno io 

[0044] ^<CDCDffltCfctir, -XiY©fitt^h>. 

ayHtt;Z *q$S<DW«J: 9 *<D#X £.Y 

©«J«"<W;t«* fit) *3>hr*-»{c£i.<fc5«c{^& 

■*rci»s. 20 

[0 04 5 } S9CC*5^4^P^^ACD{tecr)^CCfcC* 
X. y'u tfyMZ. 1 V h U fcf * - 

h ')^/-<LMi^b/c^tx(OX, YS^ZCDftcDM^n 

t^&ihcd*; X£Y©«3&s3l6h-5c£3&S'r&4.-fie 

CC«< X£ Y©7 r -^W*»<D#*^t-*/c^ecfflt» 30 
[0 04 6] **WWa^^©»fflttiaiS«*#JI8bt: 
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[01 ] *^©«A*SR-r-y-fT^ACa) RtfSS 
14* y l> * h <D#ffil (b) 

■['■H2 ]-*»w<d»* L^mm^^xm^^titc^ 



[13] *»W©»*l/C^J6M«:*il*rffllr^"tiA:* 



[14] ^H^^ffl^iA^c^X^AOD^U^^^^T 

[15 ] ^m^^stJeniiia 

[16] AI»£^JH%ttfi#tttiiS-- 
[17] Mh><L F^AOr>Slffl£^ 

us] rc.F >'3&sffi*ppt>fc£ si^ar fcfca&cc* h 
[19] MF>^ffi*pnc>fc£#* j P»iL/"c«jE-r4*' 

100 * V^A 

1 0 2. 1 0 4 Ah> 
110 fiB-fe>1f- 

12 4 -fe>V>y • ^t/U* h 

i 3 o (t *wsmt& 

1 3 2. 1 34 ««J1 

1 3 6 mmm 

2 2 2A, b, c, d RFm^&mmz 



[in 



[12] 
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[0 3 ] [05 ] 




14] 




C8) 



-16 1 44 9 



[13 6] 



162^ 



r 



220 



r 



102 



170 

v 



222A 



+15V 



.224 



20.5 kn 



10kO 




- 3.01k CI 



22B 



230 



172 



^=s l' 2226 I - 



174 



222C \- 



t76" 



222D |" 



232 







d — 




V 4 


A/? 



192 



[^8 ] 




z 4 

Z-SET 



a7 

VELOCITY - 



(9) 
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[09] 



WAIT AT 

READ VX1 , VX2, VY1 AND VY2 



Z = K3/(VX1 + J/X2 + VY1 + VY2) 



-302 



41 



308 



SET FLAG -1 




316 



READ VX1 , VX2. VY1 AND VY2 

2T= K3/(VX1 + VX2+VY1 + VY2) 
VELOCITY = (2 - ZT)/AT 
TC - T + ZTA/ELOC1TY 
X = K1*VX1/((VX1 + VX2) 
Y - K2*VY1/(VY1 + VY2) 

TRANSMIT TC. X. Y. ZT 
SET FLAG « 0 



